#include "MATHS.h"

MATHS_T* MATHS_t;



//************************************
// Method:    	CALCU_SAMA					//< SAMA运算函数
// Programmer:  lww
// Time:		2018/11/16
// Returns:   	bool						//< 成功：true；失败：false
// Parameter: 	Model_Base_t * arg			//< 模块参数结构体指针
// Parameter: 	float dt					//< 运算周期
// Parameter: 	bool * DI					//< 数字量输入值数组指针
// Parameter: 	bool * DO					//< 数字量输出值数组指针
// Parameter: 	bool * AI					//< 模拟量输入值数组指针
// Parameter: 	bool * AO					//< 模拟量输出值数组指针
//************************************
bool CALCU_SAMA(MATHS)(Model_Base_t* arg, float dt, bool* DI, bool* DO, float* AI, float* AO)
{
    
	/****************变量定义区开始**************/
	/*<<<<<定义输入变量>>>>>*/
	float input_value;						//< 输入值
	/*<<<<<<<<<<<<<<<<<<<<<<*/

	/*<<<<<定义输出变量>>>>>*/
	float Output_Value = 0;					//< 输出值
	/*<<<<<<<<<<<<<<<<<<<<<<*/

	/*<<<<<定义参数变量>>>>>*/
	float K_Gain[MAX_MATHS_NUM];			
	/*<<<<<<<<<<<<<<<<<<<<<<*/

	//int i, AI_Num;
	int i;

	/****************变量定义区结束**************/

	NAME(MATHS)* Obj = (NAME(MATHS)*)arg;

	/****************变量赋值**************/
	/*<<<<<输入变量赋值>>>>>*/
	input_value = AI[0];
	/*<<<<<<<<<<<<<<<<<<<<<<*/

	/*<<<<<参数变量赋值>>>>>*/

	/*AI_Num = Obj->Base.IO_Num.AI_Num;
	for (i = 0; i < AI_Num; i++)
	{
		K_Gain[i] = Obj->Par.K_Gain[i];
	}*/
	for (i = 0; i < MAX_MATHS_NUM; i++)
	{
		K_Gain[i] = Obj->Par.K_Gain[i];
	}

	/*<<<<<<<<<<<<<<<<<<<<<<*/

	/**************变量赋值结束************/

	/********************************************/
	/**************算法功能实现开始**************/
	/********************************************/
	
	/*for (i = 0; i < AI_Num; i++)
	{
		Output_Value = Output_Value + (float)(K_Gain[i] * pow(input_value, (double)i));
	}*/
	for (i = 0; i < MAX_MATHS_NUM; i++)
	{
		Output_Value = Output_Value + (float)(K_Gain[i] * pow(input_value, (double)i));
	}

	/********************************************/
	/**************算法功能实现结束**************/
	/********************************************/

	/****************运算结果输出**************/
	AO[0] = Output_Value;
	/**************运算结果输出完毕************/
	return true;
}



//************************************
// Method:    	BCPARA						//< 广播SAMA参数变量函数（无参数需要广播的模块直接将BCPara函数设置为NULL即可）
// Programmer:  lww
// Time:		2018/11/16
// Returns:   	int							//< 成功：返回打包字节个数；失败：返回0
// Parameter: 	Model_Base_t * arg			//< 模块参数结构体指针
// Parameter: 	void ** Data				//< 广播SAMA参数的数据包的指针
//************************************
int BC_PARA(MATHS)(Model_Base_t* arg, void** Data)
{
	NAME(MATHS)* Obj = (NAME(MATHS)*)arg;
	BC_PARA_PUBLIC(Obj);
	return 0;
}



//************************************
// Method:    	CHANGE_PAR				//< 在线修改模块参数函数
// Programmer:  lww
// Time:		2018/11/16
// Returns:   	int						//< 读取字节长度计数值
// Parameter: 	Model_Base_t* arg		//< 指定模块类型链表的指针
// Parameter: 	void** Data				//< 存放数据包当前指针位置的地址
//************************************
int CHANGE_PAR(MATHS)(Model_Base_t* arg, void** Data)
{
	int _iLen = 0;
	MEMREAD(((NAME(MATHS)*)arg)->Par, Data[0]);
	return _iLen;
}
